N88-23238 


BASE REACTION OPTIMIZATION OF MANIPULATORS 
WITH REDUNDANT KINEMATICS 

C.L. Chung and S. Desa 
Department of Mechanical Engineering 
Carnegie Mellon University 
Pittsburgh, PA 15213 

Abstract 

Manipulators used in space applications are operated under, microgravity 
conditions. Base reactions of space manipulator are directly exerted on the supporting 
space structure. It is desirable to make these reactions as small as possible in order to 
reduce their influence on the dynamics of the supporting space structure. Furthermore, 
in delicate experiments conducted in space, the test specimen would have to be 
moved carefully without subjecting it to excessive accelerations and jerks. It follows 
that minimization of base reactions and limitation of end-effector accelerations and 
jerks are important objectives for space manipulators. 

In this presentation, a trajectory generation method for space manipulators is 
introduced. The approach developed employs a manipulator with redundant 
kinematics. The method is implemented in two steps. First, the end-effector trajectory 
is developed to satisfy motion requirements. Next, the joint trajectories are developed 
to minimize base reactions. This presentation describes the analytical development of 
the method, and presents an example to illustrate the method. 
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Types of Manipulators 


Manipulators can be categorized according to their degrees of freedom into two 
groups: nonredundant and redundant. Nonredundant manipulators have the minimum 
number of degrees of freedom required to follow a general trajectory. If a manipulator 
has more than the minimum number of degrees of freedom required to perform a task, 
then it is called a redundant manipulator. 


Manipulators 



non-redundant redundant 


2 DOF Manipulator 3 DOF Manipulator 

(1 degree of redundancy) 



Bose Base 
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Space Manipulator of NASA 


Manipulators used in space are operated under microgravity conditions. Base 
reactions of a space manipulator are directly exerted on the supporting space 
structure. It is desirable to make the reactions as small as possible in order to reduce 
their influence on the dynamics of the space structures. Besides the requirement of 
small base reactions, delicate experiments conducted in space require that test 
specimens be moved carefully without subjecting them to excessive accelerations and 
jerks. 



• desire to move specimens without excessive acceleration 
. require base reactions ( f 0 , N 0 ) to be as small as possible 
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Problem Statement 


The trajectory problem for redundant manipulators which we are going to address has 
two requirements: (1) to move a redundant manipulator according to task 
specifications; (2) to minimize base reactions ( N 0 and F 0 ) transmitted by 
manipulators to the base during motion. 



A Planar Redundant Manipulator 


• plan end-effector trajectory to satisfy acceleration 
constraint 

• determine joint trajectories that MINIMIZE BASE REACTIONS 
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Proposed Approach 


The trajecotry planning problem can be approached by splitting the problem into two 
parts. This enables us to deal with the end-effector trajectory and joint trajectories 
separately. The first part generates the end-effector trajectory that satisfies task 
specifications. The second part obtains joint space solution that minimizes base 
reactions. 


tan i._ 


Determination of end-effector trajectory 


Eart2 


Finding joint trajectories that minimize 
base reactions 
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Part 1 : End-effector Trajectory Generation 


The first part of the approach deals with the generation of end-effector trajectory, r(t) to 
satisfy certain task specifications. The task specifications of interest are total distance 
of the straight-line path (D-p), maximum acceleration of end-effector trajectory (a max ), 
and total time of task (T). 


IDEA: 



Task Specs. 

1 . Dj : total distance of the straight path 

2. a max : max. acceleration of the path 

3. T : time to accomplish the task 


Fnd-effector 

I(t) 
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Point-to-point Motion 


A point-to-point motion is considered as the motion of an end effector moving from a 
specified initial position to a specified final position. A simple way to execute this 
motion is to move the origin of a coordinate frame fixed to the end effector along a 
straight-line path that connects the two points. 



» accomplish by a straight line from A to B 

v(t) - dQ (speed along the straight path) 
dt 
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End-effector Trajectory Description 


One of the requirements in planning end-effector trajectory is to have zero velocity at 
initial and final positions. Cycloid curve which satisfies this requirement can be used to 
describe the linear speed of the end-effector trajectory. Furthermore, it has smooth 
kinematics properties and can be defined by using only three constants (a, b, c). 


Linear Speed : 

Cycloid: v(p) - b(1 - cos p) 

t(p) -a(p-csinp) 
P is the parameter. 



•I 


p = 0 ( starting position) 

P = 2n ( end position) 
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Determination of a, b , and c 


The three constants a, b, and c can be determined by forcing cycloid function to satisfy 
three motion constraints. By solving the following three equations, we can obtain the 
valus for the constants. 


Total Time of Task : T = 2jia 

Total Distance : D T « 2 n a b ( 1 + 0.5 c) 

Max. Acceleration: 


|a max |= b/a(1-c 2 )-°-5 


From above 3 eqns. «> a, b , c 
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Part 2: Determination of Joint Trajectories 

The basic idea of proposed approach is to pose the inverse kinematics problem as an 
optimization problem with a cost function that measures the base reactions. The 
approach begins by partitioning the joint variable vector, q into 2 portions. Then the 
Jacobian matrix is partitioned into a nonsingular square Jacobian matrix and a 
submatrix. Using these partitioned matrices, we are able to represent the motion of all 
the joints in terms of an optimization parameter matrix. The unique joint space solution 
can be determined by finding the optimal parameter matrix for the optimization 
problem. 


Recall 

r = J a ( 1 ) 

Step l : Partition g & J 


5 J 



(U m l 1 0) 


Step 2: Express g m &cj m in terms of g r andcj r 
9 m = 0i ( 9 r ) (2) 

:q m - g 2 (g r 9 r > ( 3 ) 


Step 3 : Setup a cost function, J({g r q r ) 


Step 4: minimize J c 


min(J c )=> fl r ,jj r 


0 , 3 ; 


• 9m 
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Part 2 Determination of Joint Trajectories (cont'd) 


For the purpose of optimization, 
flr = £ l(t) 

where I(t) - [1 , t, £ 

C - constant coefficient matrix 


For this problem: 



To minimize base reactions, 

Local Cost Function : J C = B T Q B 


where B. 


io 

Wo 


Q : positive definite weighting matrix 
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Algorithm of the Proposed Approach 


An algorithm of the proposed approach and a computer program written in Pascal 
have been developed to implement this methodology. The flowchart below illustrates 
the basic algorithm. 
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Illustrative Example 

A 4 degrees of freedom spatial manipulator as shown below is studied. It has three 
links with lengths of /y,/^, and l 3 respectively. For point-to-point spatial motion, three 
degrees of freedom are required. Therefore, one degree of redundancy is available. 
The reference frame is fixed at the base. Link 1 is mounted to the supporting 

structure and the other two links are each driven by a differential drive mechanism 
which has two outputs that rotate about orthogonal axes. For the purpose of kinematic 
and dynamic analyses, this mechanism can be considered as two intersecting revolute 
joints. 



A 4 DOF Traction-Driv# Manipulator 
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Results of Example : Optimal Cost Function 


Using the algorithm developed in this research, the time history of cost function given 
by J = rTq R ( Q = identity matrix) is shown in Figure 2. 



Optimal Basa Reactions Cost Function 
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Optimal Joint Trajectory 


A typical joint trajectory that minimizes base reactions is shown in the figure. This figure 
shows that using the proposed approach, we can obtain smooth joint trajectory. 



Optimal Trajectory of joint 1 


Conclusions 


In this presentation we have shown how kinematic redundancy can be employed in 
planning joint trajectories to minimize base reactions exerted by the manipulator on 
the supporting space structure. The results of the example show that small base 
reactions are exerted on the space structure. The major advantage of this approach is 
no special restrictions are imposed on the cost function. The disadvantage is that it is 
computationally intensive because an optimization routine is required to find the 
optimal joint trajectories. 


{+) We have obtained a workable approach for this 
problem. 

It can handle cost functions which include dynamics 
relatively easily. 

(-) The approach is computationally intensive. 
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